using System;
using Microsoft.SPOT;

namespace MLRobotic
{
    public static class TestPID
    {


        public static void Carre(uint cote)
        {
            Position postionActuelle = Robot.currentPosition;
            Position.AddTarget(new Position(postionActuelle.X, postionActuelle.Y + cote));
            Position.AddTarget(new Position(postionActuelle.X+ cote, postionActuelle.Y + cote));
            Position.AddTarget(new Position(postionActuelle.X+ cote, postionActuelle.Y));
            Position.AddTarget(new Position(postionActuelle.X, postionActuelle.Y ));
            Position.AddTarget(new Position(postionActuelle.Teta));
            
        }

        public static void AllerRetour(uint distance)
        {
            Position postionActuelle = Robot.currentPosition;
            Position.AddTarget(new Position(postionActuelle.X, postionActuelle.Y + distance));
            Position.AddTarget(postionActuelle);
        }

    }
}
